
#include "IMU.h"

bool IMU::encode(int byteData){
	static uint8_t byteBuffer[80];
	static int byteIdx=0;
	bool flgBuffFull;

	byteBuffer[byteIdx]=byteData;
	byteIdx++;

	if(byteIdx>=80){
		flgBuffFull = true;
		byteIdx=0;
	}
	else
		flgBuffFull = false;

	//if(flgBuffFull){
	//	IMU_handler.accelX = *((int*)&byteBuffer[0]);
	//	IMU_handler.accelY = *((int*)&byteBuffer[0]);
	//	IMU_handler.accelZ = *((int*)&byteBuffer[0]);
	//	IMU_handler.pitch = *((int*)&byteBuffer[0]);
	//	IMU_handler.roll = *((int*)&byteBuffer[0]);
	//	IMU_handler.yaw = *((int*)&byteBuffer[0]);
	//	IMU_handler.heading = *((int*)&byteBuffer[0]);
	//}

	return flgBuffFull;
}